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摘要 : 为 提高 全 球 导 航 卫 星系 统 定位 精度 与 连续 性 ， 提 出 结合 使 用 高 程 坐标 分 量 与 速度 分 
量 ， 设 计 构 成 一 种 组 合 滤波 器 。 利 用 速度 测量 值 不 断 对 用 户 高 程 进行 平滑 与 修正 ， 获 得 高 精度 
的 高 程 坐 标 值 ， 并 由 此 对 测量 方程 组 形成 高 程 约束 条 件 ， 进 而 提高 全 球 导 航 卫 星系 统 三 维 定位 
精度 及 接收 机 钟 差 解 算 精 度 。 同 时 ， 由 于 滤波 器 处 理 后 的 高 程 值 序列 具有 较 高 的 精度 和 良好 的 
平滑 性 ， 因 此 特别 适 于 拟 合 与 外 推 ， 从 而 更 好 地 辅助 卫星 信号 缺失 的 非 完备 星座 情况 ， 实 现 连 
续 三 维 定位 。 最 后 ， 通 过 全 球 定 位 系统 实测 实验 对 方法 进行 了 分 析 ， 验 证 了 其 可 行 性 与 实用 性 。 
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1 概 Xt 
S 受 卫 星星 座 几何 分 布 图 形 的 影响 ， 卫 星 导 航 系统 在 高 程 方向 上 的 定位 精度 一 般 较 差 。 其 单 频 粗 码 
= 定位 误差 一 般 为 几米 至 十 几米 ， 在 信号 遮挡 或 定位 条 件 较 差 时 甚至 达 几 十 米 。 并 且 ， 作 为 同一 组 最 小 
LÍ 二 乘 估 计 解 ， 高 程 解 算 值 与 其 他 未 知 数 之 间 是 相关 的 ， 高 程 坐标 的 误差 也 会 影响 用 户 二 维 平面 坐标 及 
Gai 接收 机 钟 差 的 解 算 精 度 。 因 此 ， 高 程 定 位 精度 欠 佳 一 直 是 卫星 导航 系统 存在 的 一 大 问题 。 
©O 针对 这 一 问题 ， 学 者 们 进行 了 大 量 的 研究 ， 希 望 能 够 通过 其 他 方法 或 手段 获得 比 直接 定位 解 算 更 


精确 的 高 程 值 ， 以 改善 高 程 定位 误差 较 大 的 问题 。 同 时 ， 这 样 也 能 够 对 测量 方程 组 形成 高 程 约束 条 
件 ， 从 而 提高 二 维 平面 及 接收 机 钟 差 的 解 算 精 度 。 在 我 国 北斗 一 代 卫 星 定位 系统 及 文 [1-3] 中 ， 曾 采 
用 数字 高 程 模 型 ( Digital Elevation Model, DEM) 与 电子 地 图 获得 用 户 大 地 高 。 而 在 中 国 区 域 卫星 定位 
系统 (China Area Positioning System, CAPS) IT 期 中 ， 也 曾 利用 气压 测 高 技术 辅助 当时 尚 不 完善 的 卫 
星星 座 实现 三 维 定位 "1 。 文 [8-9] 提 出 进一步 将 气压 测 高 技术 应 用 于 地 面 移 动 通信 基站 中 ， 将 其 作为 
气压 校正 基准 点 并 利用 通信 传输 链 路 将 相关 测量 数据 传送 给 附近 用 户 ， 以 修正 获得 高 精度 的 用 户 绝 对 
高 程 值 。 文 [10] 根 据 高 程 坐标 分 量 与 接收 机 钟 差 之 间 存 在 高 相关 性 的 特征 ,在 差分 站 的 基础 上 模拟 
和 预测 接收 机 钟 差 ， 并 在 定位 方程 组 中 添加 一 个 关于 接收 机 钟 差 变 化 的 辅助 方程 ， 以 减 小 垂直 精度 因 
子 值 ， 提 高 高 程 定位 精度 7 。 

以 上 方法 虽然 能 在 不 同 程度 上 改善 高 程 误差 ， 提 高 定位 精度 ， 但 都 需要 增加 额外 设施 或 手段 ， 在 
增加 投入 与 成 本 的 同时 ， 也 加 大 了 定位 系统 的 复杂 性 。 为 此 ， 本 文 提出 一 种 利用 卫星 导航 系统 自身 定 
位 信息 有 效 提高 高 程 定位 精度 的 方法 。 通 过 引入 高 程 方向 速度 测量 值 、 结 合 高 程 定位 值 ， 设 计 组 成 一 
个 一 定 长 度 的 滤波 器 ， 不 断 利用 最 新 测量 值 对 用 户 高 程 进行 实时 平滑 处 理 。 由 于 即使 当 高 程 方向 上 的 
定位 误差 较 大 时 ， 高 程 方向 上 的 速度 值 也 能 够 具有 很 高 的 精度 ， 因 此 滤波 器 能 够 有 效 获 得 高 精度 的 用 
户 实时 定位 高 程 值 ， 且 无 需 增加 任何 额外 设备 。 该 方法 既 能 用 于 正常 定位 ， 有 效 提高 定位 精度 ， 也 能 
用 于 卫星 信号 短暂 缺失 的 非 完备 定位 情况 ， 帮 助 实 现 三 维 定位 。 另 外 ， 由 于 卫星 定位 星座 分 布 的 原 
因 ， 其 高 程 坐标 分 量 与 接收 机 钟 差 之 间 存 在 着 很 高 的 相关 性 '… 。 因 此 在 高 程 精度 得 到 提高 的 同时 ， 
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其 接收 机 钟 差 解 算 精度 也 能 相应 提高 。 最 后 ， 通 过 全 球 定位 系统 实测 实验 对 方法 进行 了 分 析 与 验证 。 
实验 结果 表明 ， 该 方法 效果 显著 ,简单 易 行 ， 具 有 很 强 的 实用 性 。 


2 速度 平滑 高 程 原理 与 方法 


在 车 载 、 船 舶 定位 等 应 用 领域 ， 用 户 运 动 状态 符合 牛顿 惯性 运动 定律 ， 其 高 程 位 置 的 变化 一 般 较 
为 缓慢 和 平滑 。 因 此 ， 将 每 个 历 元 的 定位 过 程 独立 起 来 、 以 单 点 定位 解 算 结果 得 到 的 高 程 值 作 为 最 终 
的 输出 结果 ， 显 然 不 是 最 佳 选择 。 实 际 上 ， 由 于 即使 当 高 程 坐标 分 量 的 定位 误差 较 大 时 ， 高 程 速度 分 
量 也 能 够 具有 很 高 的 精度 ， 因 此 完全 可 以 将 两 者 结合 起 来 ， 利 用 高 程 解 算 值 获得 绝对 起 始 值 ， 利 用 速 
度 解 算 值 获得 准确 的 高 程 变 化 量 ， 从 而 构成 一 个 组 合 滤波 器 ， 对 高 程 值 进 行 平滑 。 

这 种 思想 与 卫星 导航 中 载波 相位 平滑 伪 距 测量 值 的 方法 "中 类 似 ， 都 是 通过 对 精度 欠 佳 的 绝对 
测量 值 取 均 值 的 方式 获得 一 个 较为 准确 的 绝对 起 始 值 ， 并 利用 高 精度 的 相对 测量 值 获得 该 绝对 起 始 值 
的 变化 量 。 

2.1 速度 平滑 高 程 滤波 髓 设计 

对 于 用 户 在 最 新 历 元 n 的 高 程 值 ， 可 利用 之 前 /个 高 程 解 算 值 H(i=1, 2, …, [) 获 得 其 1 个 高 

程 估计 值 A, (521,2, =, 1): 


^ 


— H 
H, | =H, tv 


n-l 


T 


H, » -H,, 十 (vL. 十 oa) 了 (1) 


i. =H, + (CHR * ds E vLuT 
其 中 ,vi (k=1, 2,…, 7) 为 高 程 方向 的 速度 分 量 ; 上 代表 参与 平滑 的 历 元 数 ; 7 为 定位 时 间 间 隔 。 可 
根据 这 一 系列 估计 值 以 获得 最 新 历 元 ” 的 高 程 平滑 值 到 : 


—— 1 ^ 
H, 27 Y H, ;. (2) 


若 考 虑 当前 历 元 n 时 ， 用 户 实际 定位 解 算 结 果 已 ， 则 可 利用 上 述 方法 先 求 得 下，， 并 按 加 权 均 值 方 
式 获得 平滑 后 的 高 程 值 : 


i, 7 H, zs 
(3) 式 即 为 一 般 的 速度 平滑 高 程 滤波 器 ，;! 为 滤波 器 的 长 度 ，! 值 越 大 ，H, 越 依 赖 于 速度 值 ， 瓦 也 就 
越 平 滑 。 

对 于 何 时 开启 滤波 器 分 为 两 种 情况 : 一 是 等 待定 位 历 元 数 达到 滤波 器 长 度 1， 由 此 获得 准确 的 
平滑 值 五 ,, ， 再 根据 (3) 式 开始 正常 运行 滤波 器 ， 二 是 从 定位 过 程 一 开始 即 开 启 滤波 器 ， 采 用 正常 定 
位 后 的 第 1 个 高 程 解 算 值 H, 初始 化 也 的 值 : 

H,-H,, (4) 


并 根据 历 元 数 的 增加 ， 不 断 更 新 已 的 值 ， 直 至 达到 滤波 器 长 度 1 为 止 。 第 2 种 方式 能 够 使 滤波 器 从 定 
位 一 开始 即 得 到 运用 ， 但 由 于 定位 初期 历 元 数 较 少 ， 因 此 可 能 会 受 较 大 误差 值 的 影响 而 在 初期 产生 一 定 
的 偏差 ， 滤 波 器 需要 经 过 一 段 时 间 的 运行 并 达到 理想 设计 长 度 后 ， 才 能 逐渐 趋 于 稳定 并 消除 此 偏差 。 
2.2 滤波 器 精度 分 析 

由 (1) 式 至 (3) 式 可 以 看 出 ， 速 度 平滑 高 程 滤波 器 的 误差 主要 来 自 两 方面 : 一 是 各 历 元 实际 高 程 
解 算 值 经 平均 后 剩 下 的 误差 ; 二 是 各 历 元 速度 解 算 值 在 滤波 器 长 度 1 内 的 累积 误差 。 

由 (1) 式 可 得 


]--— 
(H, +v T) . (3) 
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[oi t (CH t4 a) Toe (ur * P Tossham i5]. (5) 


n-l 


1d 
H, = p H, + 


设 每 次 定位 的 高 程 坐 标 分 量 均 方 误差 为 rw ， 高 程 速 度 分 量 均 方 误差 为 r,， 根 据 误差 传播 律 可 得 也 
的 均 方 误差 op: 


muc Pea SUD fas T(*1) a 
H P H P 2 v l H 2l v 
= Hr gy 十 a T, 


目前 全 球 导航 卫星 系统 的 高 程 速度 误差 o, 一 般 小 于 0.3 m/s， 而 接收 机 定位 间隔 7 了 约 为 0.1~1s。 
因此 ，(6) 式 右 端 由 速度 误差 造成 的 影响 很 小 。 故 可 近似 认为 滤波 器 精度 为 
aray (7) 


J 
通过 一 个 长 度 为 1 的 速度 平滑 高 程 滤波 器 ， 能 够 将 高 程 坐标 分 量 均 方 误差 减 小 至 原来 的 约 A 


(6) 


3 速度 平滑 高 程 定位 方法 


3.1 正常 星座 情况 下 的 增强 定位 方法 

当 可 视 卫 星 多 于 4 颗 时 ， 同 时 存在 两 类 定位 算法 : 后 台 不 断 利用 正常 定位 解 算得 到 的 高 程 值 及 ， 
通过 滤波 器 得 到 用 户 实时 高 程 平滑 值 及,;， 而 增强 算法 则 将 五, 作为 已 知 量 处 理 ， 重 新 对 测量 方程 组 进 
行 求解 。 方 法 流程 如 图 1。 


历 元 n-1 历 元 n 历 元 n+1 


长 度 为 1 的 高 程序 列 
Hpi Hg Hyg 


长 度 为 1 的 高 程序 列 
H,, Hp sig Hyg 


长 度 为 7 的 高 程序 列 
Hp > Hy sias Hyg 


速度 平滑 高 程 滤波 器 


平滑 后 的 实时 高 程 平 清 后 的 实时 高 程 平滑 后 的 实时 高 程 
Ha H, Ha 


高 程 约束 解 算 


约束 解 | 


约束 解 


(Xn. Yn» Zn) 


约束 解 


(Xp. Vn-1 Zn-1) (Xs Yn Zn+1) 


输出 输出 


图 1 增强 算法 流程 图 


Fig. 1 Enhancement algorithm flowchart 


此 时 ， 增 强 算法 实际 上 相当 于 减少 了 一 个 未 知 数 ， 对 原 测量 方程 形成 高 程 约束 条 件 : 
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(xj; x) *(y,-y) + (z-z)? *cAt 2 p(i2 1, 2, =, n) 
xb y! . E - . (8) 
(a *h)' (bh) 
HB, nz4 为 观测 卫星 个 数 ，x;、y; Mz 为 第 ; 颗 卫 星 在 地 心地 固 坐 标 系 下 的 坐标 ; p; 为 第 i 颗 卫 星 
至 用 户 的 伪 距 观测 值 ，x、y、z 和 Ai 是 待 求 量 , 分 别 为 用 户 接 收 机 位 置 坐标 及 接收 机 钟 差 a. b 为 
地 球 基准 椭 球 的 长 、 短 半 轴 ; h 为 用 户 海拔 高 H, 经 简单 坐标 转换 后 的 大 地 高 。 关 于 (8) 式 的 具体 解 算 
方法 可 见 文 [15-18] 。 
3.2 非 完备 情况 下 的 辅助 定位 方法 

当 可 视 卫 星 少 于 4 颗 时 ， 称 为 非 完备 星座 情况 。 若 不 依赖 其 他 辅助 手段 或 信息 ， 用 户 将 无 法 完成 
正常 定位 。 此 时 ， 可 利用 之 前 稍 早 的 高 程 定位 值 进行 外 推 ， 以 获得 非 完备 情况 下 的 高 程 预测 值 ， 从 而 
将 定位 解 算 问 题 变 为 二 维 。 

相 比 于 直接 对 高 程 定位 值 进行 建 模 和 外 推 ， 利 用 根据 滤波 器 进行 平滑 后 的 高 程 值 序列 进行 外 推 的 
主要 优势 在 于 : (1) 经 过 滤波 器 平滑 后 的 高 程 值 更 为 准确 ， 因 此 对 其 进行 建 模 和 预测 也 能 够 获得 更 高 
的 精度 ; (2) 由 于 平滑 后 得 到 的 高 程序 列 曲线 更 为 明显 ， 因 此 在 对 其 进行 拟 合 和 外 推 时 能 够 采用 更 少 


- 的 先 验 数据 ， 减 小 计算 量 ，(3) 由 于 各 个 历 元 的 高 程 值 经 过 了 足够 长 度 窗口 的 平滑 ， 所 以 可 以 有 效 避 
© 免 和 克服 观测 数据 突变 带 来 的 粗 差 ， 抗 差 性 显著 提高 。 

和 另外 需要 指出 ， 预 测 高 程 辅助 非 完备 定位 的 效果 很 大 程度 上 取决 于 用 户 所 处 的 运动 环境 。 若 用 户 
a6 位 于 较 平 坦 的 地 区 ， 高 程 变化 较为 缓慢 ， 则 预测 高 程 可 以 在 很 长 一 段 时 间 内 辅助 非 完 备 定位 。 甚 至 可 
= 以 采用 对 先 验 高 程 值 序列 进行 均值 或 加 权 均 值 的 处 理 方法 ， 即 能 获得 良好 的 定位 效果 。 相 反 ， 若 用 户 
-— 高 程 变化 较为 剧烈 ， 预 测 高 程 将 难以 反映 真实 高 程 的 变化 情况 ， 从 而 使 方法 效果 受 限 。 


D 4 实验 与 分 析 


利用 中 科 微 电子 有 限 公 司 研制 的 CASIC 卫星 导航 接收 机 模块 ， 以 1 Hz 频率 通过 串口 传输 方式 输 
出 自 定义 二 进 制 格式 的 全 球 定位 系统 卫星 广播 星 历 及 单 频 、C/A 码 伪 距 测量 数据 。 基 于 该 模块 及 输 
出 编程 ， 并 进行 实时 定位 实验 与 验证 。 

为 更 明显 地 分 析 和 比较 滤波 絮 及 定位 方法 在 正常 星座 情况 时 的 性 能 ， 在 某 个 具有 一 定 谈 挡 的 已 知 
坐标 点 上 进行 长 时 间 的 静止 测量 。 首 先 ， 直 接 解 算得 到 用 户 在 该 点 上 全 部 观测 历 元 的 高 程 坐标 值 ; 然 
后 ， 采 用 一 个 长 度 为 100 s 的 速度 平滑 高 程 滤波 器 对 其 进行 平滑 处 理 ， 两 者 结果 如 图 2。 


真实 高 程 值 
一 一 一 单 点 定位 高 程 值 
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图 2 高 程 坐标 分 量 对 比 
Fig. 2 Precision comparison of elevations 
可 以 看 出 ， 经 速度 平滑 后 得 到 的 高 程 更 加 平 请 、 稳 定 ， 与 真实 高 程 值 更 为 吻合 。 在 此 基础 上 按 图 1 
流程 进行 增强 定位 方法 解 算 ， 并 与 原 定 位 结果 比较 ， 结 果 如 图 3。 
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统计 图 3(a) 中 的 误差 可 知 ， 增 强 算法 将 原始 二 维 定位 误差 减 小 了 约 30%， 具有 显著 的 效果 ; 而 图 3 
(b) 中 的 接收 机 钟 差 值 序列 也 更 为 平滑 ， 符 合 实际 规律 ， 说 明 由 于 高 程 坐标 分 量 与 接收 机 钟 差 之 间 的 高 
相关 性 ， 更 准确 的 高 程 确实 能 够 带 来 更 准确 的 接收 机 钟 差 值 ， 从 而 能 够 帮助 提高 接收 机 的 授时 精度 。 
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图 3 增强 算法 定位 解 算 结 果 对 比 。(a) 二 维 定位 结果 对 比 ; (b) 接收 机 钟 差 解 算 结 果 对 比 
Fig.3 The positioning results of enhanced algorithm and original method. (a) Comparison for 2D 


positioning results; (b) Comparison for the clock error of the GPS receiver 
+ M 
5 8h 论 


受 星 座 分 布 几 何 图 形 的 影响 与 制约 ， 高 程 定位 精度 一 直 是 全 球 导 航 卫 星系 统 的 一 大 短 板 。 为 此 ， 
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曾 提出 使 用 电子 地 图 匹配 、 气 压 测 高 、 基 准 站 差分 修正 等 多 种 手段 以 获得 更 准确 的 高 程 值 ， 从 而 提高 
全 球 导 航 卫星 系统 高 程 及 三 维 定位 精度 。 然 而 ， 这 些 方 法 通常 需 在 用 户 或 定位 基准 端 配备 额外 的 硬件 
设施 ， 在 加 大 成 本 的 同时 也 增加 了 系统 的 复杂 性 。 并 且 ， 由 于 电子 地 图 及 气压 测 高 技术 一 般 只 能 将 用 
户 高 程 定位 精度 提高 至 1 m 左右 ， 因 此 仪 能 应 用 于 音频、 粗 码 等 一 般 民用 领域 。 而 当 采 用 差分 、 多 频 
或 载波 相位 等 高 精度 定位 手段 后 ， 全 球 导航 卫星 系统 高 程 定位 精度 本 身 已 优 于 1m， 此 时 上 述 方法 将 
难以 继续 起 到 提升 作用 。 
实际 上 ， 类 似 于 载波 相位 平 请 伪 距 的 方法 ， 卫 星 定位 中 高 精度 的 相对 测量 值 总 是 能 够 对 绝对 测量 
值 进行 修正 ， 提 高 其 测量 精度 。 基 于 这 一 思想 ， 本 文 提 出 结合 使 用 高 程 坐标 分 量 与 速度 分 量 ， 利 用 高 
精度 的 速度 解 算 值 对 高 程 定位 值 进行 平滑 与 修正 。 由 此 设计 的 组 合 滤波 名 简单 规范 ， 易 于 实现 ， 且 无 
需 增加 任何 额外 设备 。 通 过 一 段 不 长 时 间 的 平滑 过 程 ， 既 能 获得 高 精度 的 高 程 坐标 ， 有 具有 很 强 的 工程 
实用 性 。 并 且 ， 由 于 当 高 程 分 量 精度 提高 时 ， 其 速度 分 量 亦 能 具有 相对 更 高 的 精度 ， 因 此 方法 能 够 适 
用 于 各 种 精度 需求 的 应 用 领域 。 
实测 实验 与 分 析 证 明 ， 该 方法 能 够 显著 提高 全 球 导 航 卫星 系统 高 程 及 三 维 定位 精度 。 同 时 ， 由 于 
滤波 器 处 理 后 的 高 程 值 序列 具有 很 高 的 精度 与 良好 的 曲线 平滑 性 ， 因 此 适 于 拟 合 与 外 推 ， 从 而 辅助 卫星 
g 言 号 缺失 的 非 完 备 情 况 实 现 三 维 定位 。 由 于 卫星 定位 高 程 坐标 分 量 与 接收 机 钟 差 之 间 存 在 很 高 的 相关 
性 ， 在 高 程 精度 得 到 提高 的 同时 ， 接 收 机 钟 差 解 算 精 度 也 能 相应 提高 ， 从 而 获得 更 高 的 授时 精度 。 因 
此 ， 该 方法 能 够 在 多 方面 对 全 球 导航 卫星 系统 进行 增强 与 辅助 ， 具 有 良好 的 实用 效果 和 应 用 价值 。 
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on Height Smoothing with Speed 
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Abstract: In order to improve the accuracy and continuity of satellite positioning, a combined filter is 


proposed to be designed and constituted by using a combination of height coordinate component and velocity 


component in this paper. User height is continually smoothed and revised to obtain a height coordinate of high 


precision, and thus forming a height constraint of measurement equations. And then, the accuracy of 3D 


positioning and receiver clock solution results could also be improved. Meanwhile, due to the high precision 


and favorable smooth texture of the height values after filter processing, they are especially suitable for fitting 


and extrapolation, and could help to assist the incomplete situation while the signal of GPS is lost and realize 


continuous 3D positioning. At last, feasibility and availability of the method are analyzed and verified by GPS 


positioning experiment. 


Key words: Enhanced Satellite Positioning Algorithm; Global Navigation Satellite System ; Satellite navigation 
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